#ifndef _TB6612_
#define _TB6612_

#include "board.h"

#define STBY_AB 0x01
#define PWMA    0x02
#define AIN1    0x03
#define AIN2    0x04
#define PWMB    0x05
#define BIN1    0x06
#define BIN2    0x07

#define STBY_CD 0x09
#define PWMC    0x0A
#define CIN1    0x0B
#define CIN2    0x0C
#define PWMD    0x0D
#define DIN1    0x0E
#define DIN2    0x0F

#define HIGH    0
#define LOW     4096

#define WheelA   0
#define WheelB   1
#define WheelC   2
#define WheelD   3


void Chassis_deforce(void);
void Chassis_onforce(void);
void Chassis_Stop(void);
void Chassis_SpeedSet(int spd[4]);

#endif
